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Abstract 


Local performance optimization for joint limit avoidance and manipula- 
bility maximization (singularity avoidance) is obtained by using the Jacobian 
matrix pseudoinverse and by projecting the gradient of an objective function 
into the Jacobian null space. Real-time redundancy optimization control is 
achieved for an eight-joint redundant manipulator having a three-axis spher- 
ical shoulder, a single elbow joint, and a four-axis spherical wrist. Symbolic 
solutions are used for both full-Jacobian and wrist- partitioned pseudo- 
inverses , partitioned null-space projection matrices , and all objective func- 
tion gradients. A kinematic limitation of this class of manipulators and the 
limitation's effect on redundancy resolution are discussed. Results obtained 
with graphical simulation are presented to demonstrate the effectiveness of 
local redundant manipulator performance optimization. Actual hardware ex- 
periments performed to verify the simulated results are also discussed. A 
major result is that the partitioned solution is desirable because of low com- 
putation requirements. The partitioned solution is suboptimal compared with 
the full solution because translational and rotational terms are optimized 
separately; however , the results show that the difference is not significant. 
Singularity analysis reveals that no algorithmic singularities exist for the par- 
titioned solution. The partitioned and full solutions share the same physical 
manipulator singular conditions. When compared with the full solution , the 
partitioned solution is shown to be ill-conditioned in smaller neighborhoods 
of the shared singularities. 


1. Introduction 

Kinematically redundant manipulators, those 
with more degrees of freedom than task constraints, 
can have a secondary task of performance optimiza- 
tion in addition to the primary task of providing 
a Cartesian trajectory. Whitney (ref. 1) derived 
the pseudoinverse solution for the primary task in 
the framework of the resolved motion rate algo- 
rithm. Liegeois (ref. 2) suggested the local redun- 
dancy resolution method that is now commonly used. 
This method uses the Moore-Penrose pseudoinverse 
(ref. 3) to solve the primary task and projects the 
gradient of an objective function into the null space 
of the Jacobian matrix to solve the secondary task. A 
good review of pseudoinverse-based local redundancy 
resolution is given in references 4 and 5. 

Many authors who claim that the Liegeois method 
is too slow for real-time application to three- 
dimensional redundant manipulators have developed 
alternate methods that focus on reducing the compu- 
tational requirements (e.g., refs. 6 8). The approach 
described in this paper applies the Liegeois method 
in real time by using symbolical pseudoinverses for 
both full and partitioned Jacobian matrices. 

Other authors have investigated the use of par- 
titioned or symbolic methods in redundancy resolu- 


tion. Kircanski and Petrovic (ref. 9) decompose a 
manipulator into redundant and nonredundant sub- 
assemblies; the redundant joints are solved by singu- 
lar value decomposition or equivalent methods, and 
the nonredundant joints are solved analytically. Holt 
(ref. 10) presents numerical computation of the ap- 
proximate pseudoinverse for a six-axis manipulator 
near singularities by taking advantage of the wrist 
partitioning of the Jacobian matrix. Chevallereau 
and Khalil (ref. 11) present symbolic pseudoinverse 
calculations for nonredundant manipulators at sin- 
gularities and for a six-degree-of- freedom manipula- 
tor on a linear track. In reference 12, Podhorodeski, 
Goldenberg, and Fenton use screw theory in an or- 
thogonal decomposition of a Jacobian matrix for a re- 
dundant manipulator to determine analytical expres- 
sions for the particular solution and the null-space 
basis. 

The references in the previous paragraph are lim- 
ited in scope in that they deal either with non- 
redundant manipulators at singularities or with re- 
dundant manipulators having only one degree of 
redundancy. In the partitioned solution of refer- 
ence 9, only three joints are treated as redundant; 
this treatment is limiting because the remaining four 
joints do not participate in optimization. This paper 
develops both full and wrist-partitioned solutions for 



a manipulator with two redundant degrees of free- 
dom. Here the partitioned solution is more useful 
because each subassembly has a redundant degree of 
freedom; thus, performance optimization is accom- 
plished for each. To the author’s knowledge, this 
work has not been published before. The motiva- 
tion for this work is real-time redundancy resolu- 
tion of manipulators for remote space applications; 
Earth-based applications can benefit also. This work 
was performed with graphical simulation and actual 
hardware. 

This paper describes real-time local performance 
optimization efforts for an eight- joint redundant ma- 
nipulator having a three-axis spherical shoulder 5, 
a single elbow joint £, and a four-axis spherical 
wrist W. (See fig. 1.) The Advanced Research Ma- 
nipulator II (ARMII) is an eight-axis manipulator in 
this class. NASA Langley Research Center has two 
of these arms. This paper has four objectives: (I) To 
apply the Liegeois method for local performance op- 
timization (joint limit avoidance and inanipulability 
maximization) of the eight-axis manipulator in fig- 
ure 1 and implement the method on actual hardware 
in real time. (2) To investigate a kinematic limitation 
of this class of manipulators and report its effect on 
redundancy resolution. (3) To present closed-form 
symbolic solutions for reduced computation. (4) To 
develop a wrist-partitioned solution for reduced com- 
putation and show that it is as valid, robust, and 
effective as the full solution. 



Figure 1. Class of eight-axis manipulators. 


This paper is organized as follows. Local per- 
formance optimization of redundant manipulators is 


presented for general applications and for the con- 
figuration of figure 1. A partitioned solution is de- 
veloped where optimization is accomplished for each 
subassembly. Singularity analysis is presented for 
both full and partitioned solutions. Results are pre- 
sented to show the effectiveness of local performance 
optimization. Results are also given to compare the 
effectiveness of the partitioned and full solutions. A 
kinematic limitation of this manipulator is investi- 
gated, the limitation’s effect on redundancy resolu- 
tion is described, and proposed design alternatives 
are presented to alleviate the problems. Finally, the 
accomplishments of this paper are summarized. 

2. Symbols 


a *- 1 


di 


H 

VH 

VH^4 

H a 




Denavit-Hartenberg parameter 
cos 6j 

Denavit-Hartenberg parameter 

Denavit-Hartenberg parameters, fixed 
manipulator lengths 

objective function for optimization 

gradient of H 

VH excluding the fourth term 

objective function for arm 
subassembly optimization 

gradient of H a excluding the fourth 
term 


Hj objective function for joint limit 

avoidance 


Hm 

H w 

VH„- 

b 

J 

J* 

J 4 

*Jox7 

J 5x7 

J (/L 


objective function for 
manipulability maximization 

objective function for wrist 
subassembly optimization 

gradient of H\y 

identity matrix of order p 

manipulator Jacobian matrix 

Moore- Penrose pseudoinverse of 
Jacobian matrix 

column 4 of J with row 1 removed 

reduced Jacobian matrix with row 1 
and column 4 removed, dimension 
5x7 

Moore- Penrose pseudoinverse of 
reduced Jacobian matrix, dimension 
7x5 

upper left partition of J, order 3x4 
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Jll 

^ LR 

Jb'L4 

T* 

J lt/L4 

T* 

J LR 
k 

k A 


kj 

k.W 

hv 

m 

n 




Si 

v 

Vj 

X 

Xi 

tti-l 

0 « 

A0; 

e 

e 

o A 

6 AH, 
QaP,i4 4 


lower left partition of J, order 3x4 

lower right partition of J, order 3x4 

column 4 of Jpp with row 1 removed 

Moore- Penrose pseudoinverse of 3 m 
with row 1 and column 4 removed 

Moore- Penrose pseudoinverse of J/^ 

scalar gain for homogeneous solution 

scalar gain for arm subassembly 
homogeneous solution 

scalar gain for joint limit avoidance 
homogeneous solution 

scalar gain for inanipulability 
maximization homogeneous solution 

scalar gain for wrist subassembly 
homogeneous solution 

dimension of task space 

dimension of joint space 

rotation matrix representing orien- 
tation of frame { 8 } in frame {4} 

array of real numbers, dimension i x j 

sin 0, 

translational terms of X, {x y z} 1 

v with first term removed 

Cartesian translational and rota- 
tional end-effector velocity 

X with first term removed 

Denavit-Hartenberg parameter 

center of travel for joint i 

Denavit-Hartenberg parameter, 
joint angle i 

half range of travel for joint i 
vector of eight joint angles 
joint rate vector 
arm subassembly joint rates, 

{01 02 03 0. } 7 

homogeneous solution for arm sub- 
assembly joint rates excluding joint 4 

particular solution for arm sub- 
assembly joint rates excluding joint 4 


Gjpp total solution for arm subassembly 

joint rates 

G at total solution for arm subassembly 
joint rates excluding joint 4 

Gh 44 homogeneous solution for joint rates 

excluding joint 4 

G( ith joint rate 

0 p, i-f . 4 particular solution for joint rates 

excluding joint 4 

Gta,± 4 total solution for joint rates excluding 

joint 4 

G\ V wrist, subassembly joint rates, 

{ 05 06 07 08 } ! 

0117/ homogeneous solution for wrist 

subassembly joint rates 

G\\/p particular solution for wrist 

subassembly joint rates 

01V7' total solution for wrist subassembly 

joint rates 

LV rotational terms of X, 

{ ^ x w y lo z } 1 

Mathematical notation: 


{ } Cartesian coordinate frame 

{., .} 7 vector components 

I I determinant of a matrix 


Arm reference points: 

E elbow 

EE end effector 

S shoulder 

W wrist 


Coordinate frames: 

4 elbow 

8 wrist 


Abbreviations: 

ARMII Advanced Research Manipulator II 

.JLA joint limit avoidance 

MM manipulability maximization 
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3. Local Performance Optimization 
Using Redundancy 

3.1. General Redundant Solution 

The resolved motion rate algorithm (ref. 1) is 
a common method for Cartesian control of redun- 
dant manipulators. Joint rates 0 are mapped to 
end-effector Cartesian velocities X by the Jacobian 
matrix J as follows: 


X = J 0 (1) 

In equation (1), Xe5R mxl , J 6 and 

0 e 5R" xl , where rn is the dimension of the task space 
(rn — 6 for spatial Cartesian control) and n is the di- 
mension of the joint space (n = 8 in this paper). To 
command a trajectory X to a manipulator, 0 must 
be solved. 

A kinematically redundant manipulator has more 
degrees of freedom than required to perform the 
task; that is, rn < n. In this case, equation (1) is 
underconstrained, and an infinite number of solutions 
for 6 generally exist. A resolved motion rate solution 
(ref. 2) is expressed as follows: 

0 = J*x + A:(l„ - J*J)VH ( 2 ) 

The first term of equation (2) is the particular solu- 
tion. The matrix J* is the Moore- Penrose pseudo- 
inverse (ref. 3) of the Jacobian matrix, which pro- 
vides the least-squares solution of equation (1) to 
achieve the Cartesian velocity command (called the 
primary task). The second term, the homogeneous 
solution, causes zero motion of the end effector. The 
linear operator (I 71 — J*J) projects an arbitrary vec- 
tor into the null space of the Jacobian matrix. This 
null-space projection matrix provides the self-motion 
of the redundant manipulator. To optimize perfor- 
mance criteria, the gradient of an objective function 
of joint angles VH is used (ref. 2). The gain k is 
positive to maximize H and negative to minimize H . 

Figure 2 shows a geometric interpretation of the 
Jacobian matrix null space for the manipulator in 
figure 1. The self-motion of this manipulator is the 
orbit of the elbow joint about the line SW. That 
is, by a reconfiguration of joints, the position and 
orientation of the end effector can be held fixed while 
the elbow joint assumes any position along the circle 
of figure 2. 

3.2. Eight-Axis Redundant Solution 

This section presents the adaptation of the gen- 
eral solution in equation (2) to the eight-axis manip- 
ulator shown in figure 1. To the author’s knowledge, 



Figure 2. Geometric interpretation of eight-axis arm self- 
motion. 


the solutions in this section have not been published 
before. This manipulator can be viewed as two sub- 
assemblies: an arm portion ( 6 \, 62 , 0 3, O 4 ) respon- 
sible primarily for positioning and a spherical wrist 
($5, 9 #7, #s) centered at W responsible primarily 
for orienting the end effector. The arm subassembly 
consists of a three- axis spherical shoulder centered 
at S, and a single elbow joint at E. The four-axis 
wrist mechanism is a roll-yaw-pitch-roll mechanism. 

The ARMII is an eight-axis manipulator of the 
class shown in figure 1. The theory of this paper 
has been implemented in real-time (33 Hz update) 
on the ARMII. Appendix A presents the following 
information for the ARMII: a photograph, the de- 
sign attributes, the kinematic diagram, the Dcnavit- 
Hartenbcrg parameters, the joint limits, the Jacobian 
matrix referred to frame {4} (which is symbolically 
the least complex among all possibilities), and a ve- 
locity coordinate transformation for use with this 
Jacobian matrix. In addition, reference 13 presents 
ARMII forward and inverse position and velocity 
kinematics equations, where the inverse solutions are 
limited to six degrees of freedom. 

3.2 A. Independent solution for elbow joint 
rate . For manipulators with a spherical wrist, a 
spherical shoulder, and a single elbow joint, the 
length of reach from S to W is a function of only 
the elbow joint angle. The SEW manipulator sub- 
assembly is shown in figure 3. To simplify the re- 
solved rate solution, the elbow joint rate is calculated 
independently of the remaining unknown joint rates. 
For the eight-axis arm, this solution (ref. 13) is given 
as follows: 
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-1 

dr } 



dz c 4 + dz 

d*s 4 


(3) 
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In equation (3), d 3 and d 5 are kinematic parame- 
ters (fig. 3), x and ij are wrist Cartesian velocity 
commands expressed in frame {4}, and S 4 and C4 
are the sine and cosine of the elbow joint angle #4. 
Equation (3) is the general form of the particu- 
lar solution for the elbow rate because the required 
wrist velocities can be calculated from commanded 
velocities in frames different from the wrist (but 
rigidly attached to frame {8}) via rigid-body velocity 
transformations. (See ref. 14.) 



Figure 3. Elbow joint geometry. 


3.2.2 . Reduced Jacobian solution. Given the 
solution in equation (3), the fourth column of the 
Jacobian matrix multiplied by O 4 is moved to the 
left side of equation (1). The result is a 6x7 
Jacobian matrix that has a maximum rank of 5 
because the elbow relationship uses one degree of 
freedom. Therefore, either row 1 or 2 must be 
removed from both sides of equation (1); row 1 is 
removed because it has more symbolic terms. (See 
appendix A.) With this reduced Jacobian matrix, the 
particular solution for the remaining joint rates is 

Wi= J 5 x 7 (X!- J 4 0 4 ) (4a) 

The vector Xi is the Cartesian velocity command 
and J4 is the fourth column of the Jacobian matrix; 
both have row 1 removed. The pseudoinverse of the 
reduced Jacobian matrix (J£ x7 ) was derived with a 
computer symbolic manipulation program (ref. 15) 
with J* = J T (JJ 7 )“*. When JJ 7 is singular, a 
numerical singular value decomposition can be used 
to calculate J* )x7 ; the exact Cartesian trajectory 
cannot be achieved, but this alternate solution is the 
best available given the singular condition. 


No loss of generality occurs when equations (3) 
and (4a) are used for the particular solution to equa- 
tion (1). If the geometric relationship of equation (3) 
is not exploited for the solution of 6J4, the pseudo- 
inverse of the 6x8 Jacobian matrix and equation (3) 
always yield the same value. 

The homogeneous solution of equation (1) for 
local redundancy optimization is 

- J 5x7 J 5x 7)VH,Y4 (4b) 

The null-space projection operator is a square ma- 
trix of order 7 that was obtained from the reduced 
Jacobian matrix. The homogeneous term for 6 4 is 
zero because of the geometric elbow constraint. Any 
addition to the particular solution (eq. (3)) would 
cause a deviation from the commanded trajectory. 
The fourth term of the constraint function gradient 
is excluded, as explained in the next paragraph. 

Again, no loss of generality is incurred when 
equation (4b) is used as the homogeneous solution 
to equation (1). In general, JJ* = I m , but J*J ^ l n . 
However, because of the geometric elbow constraint 
of the eight-axis arm, the fourth row and column 
of J*J are the same as the fourth row and column of 
the identity matrix, when J is the full 6x8 Jacobian 
matrix. The null-space projection matrix thus has 
zeros for the fourth row and column. This condition 
has two consequences. (1) Because the fourth row 
is zero, a homogeneous term for 0 4 does not exist. 
(2) Because the fourth column is zero, the partial 
derivative? of a constraint function with respect to 64 
never adds to the homogeneous terms for the other 
joint rates. 

The total solution to equation (1) is as follows. 
The particular solution for the elbow joint rate is 
given in equation (3), and the total solution for the 
remaining joints is the sum of the particular and 
homogeneous solutions: 

\ + ^//.t/4 (4c) 

3.2.3. Partitioned reduced Jacobian solu- 
tion. To greatly reduce the computation require- 
ment, a partitioned approach for the particular solu- 
tion of equation (1) was implemented. The particular 
solution for the full Jacobian matrix requires 25 times 
more computation time than the partitioned particu- 
lar solution (ref. 15). This section discusses the par- 
titioned solution and extends the theory to include 
the partitioned homogeneous solution. 

Wrist partitioning is a common method for solv- 
ing the inverse position and velocity problems of 
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nonredundant industrial manipulators with spherical 
wrists. For nonredundant manipulators, the full and 
partitioned solutions yield the same results. How- 
ever, for redundant manipulators, the partitioned so- 
lution yields a suboptimal result because the con- 
straints are optimized separately for translation and 
orientation. For instance, the full particular solu- 
tion for joint rates is the least-squares solution. The 
magnitude of the partitioned solution joint rates is 
higher, but the difference is not significant. (See 
section 4.2.1.) 

For a manipulator with a spherical wrist, equa- 
tion ( 1 ) can be written in the following partitioned 
form: 



The vectors v and are the translational and rota- 
tional Cartesian velocity commands. The Jacobian 
matrix is partitioned into upper-left, lower-left, and 
lower-right 3x4 submatrices. The vector 6 J 4 repre- 
sents the translational (arm) joint rates 1 through 4, 
and 6 \\ the rotational (wrist) joint rates 5 through 8 . 
The upper-right submatrix in equation (5) is the 
3x4 zero matrix because of the spherical wrist: The 
wrist joint rates do not affect the translational veloc- 
ities of the wrist center. In the translational equa- 
tions, £4 is first determined from equation (3). The 
particular solution for the remaining arm joint rates 
is as follows: 

l = 3*vu ( V 1 “ ( 6 a) 

The joint rate vector 8 AP,i ± 4 contains the transla- 
tional joint rates excluding # 4 , J \ 1 j 14 is the 3x2 
pseudoinverse of 3 m with column 4 and row 1 re- 
moved, V] is v with row 1 removed, and 3 1/14 is 
column 4 of J in with row 1 removed. 

The homogeneous solution for the arm joint rates 
excluding £4 is given in the following equation, 
where H 4 is a function of the arm joint angles: 

= *u( I;i - (6b) 

The total arm joint rate solution is as follows. The 
particular solution for the elbow joint rate is given in 
equation (3). Again, the homogeneous solution for 64 
is zero. The total solution for the remaining arm 
joints is the sum of the particular and homogeneous 
solutions: 


®Al\i^ 4 = + &AHA^A 


( 6 c) 


For the same reasons stated for the non- 
partitioned solution, no loss of generality is incurred 
by using equation (3) and reducing 3 m to 3\ula 
for both particular and homogeneous translational 
solutions. 

The particular and homogeneous wrist joint rate 
solutions are given in equations (7a) and (7b). The 
total wrist joint rate solution is the sum of the 
particular and homogeneous solutions: 

0 W p = J/j* (w - 3^0 at) (7a) 

&WH = Ml4 “ JlrJ Lr)VH\V ( 7l >) 

Q\vr = Q\vp + Q\yh ( 7c ) 

The full 3 LR used for the rotational equations so 
the order of the pseudoinverse J LR is 4x3. The 
effect of the total arm joint solution must be sub- 
tracted for the wrist particular solution. The ob- 
jective function H\y is a function of the wrist joint 
angles. 

Symbolic expressions for JJ ^/4 and ^ art' given 
in appendix B. Also, the symbolic forms of the 
partitioned null-space projection matrices are given 
in appendix C. 

3.2.4 • Eight- axis arm singularity analysis . 
Singularity conditions for redundant manipulators 
arise when | J J 7 " | = 0 . This matrix is symmetric 
and positive semi definite (|JJ T | > 0). For the par- 
titioned solution, singularity analysis is presented as 
follows. The calculation of 0\ in equation (3) fails 
when d '4 = 0 or d 5 = 0 (neither is possible) or when 
84 = 0 °, 180°. The joint angles follow Craig’s con- 
vention (ref. 14), and the zero position for all joint 
angles is given in figure A 2 of appendix A. The singu- 
larity condition for the remaining translational joints 
is independent of 8\ . (In appendix B, D[j is given.) 

~ ( ^ s 4^UL = 0 ( 8 ) 

Of the three terms in equation ( 8 ), only the last two 
can become zero. When 84 = 0°, 180°, the transla- 
tional joints are in the elbow work space limit singu- 
larity. At 84 =0°, the elbow is fully extended and 
the freedom to translate along EW has been instan- 
taneously lost. Similarly at 84 — 180°, the elbow is 
folded upon itself. The term Dm can become zero 
in two ways. 

T 8 2 = 0 °, 180° and 0 3 - ±90°. (See fig. 4(a).) 
In this case, joint 4 can instantaneously move 
W tangentially to the link EW, and joint 1 , 2 , 
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Singular directions 



Front view Side view 

(a) Internal singularity for arm subassembly. 





Front view Side view 

(b) Doubly degenerate singularity for arm subassembly. 



(c) Internal singularity for wrist subassembly. 


Figure 4. Singularity configurations. 


or 3 can move W perpendicular to the plane of 
the side view. However, the freedom to trans- 
late radially along link EW is gone (singular 
direction). 

2. 62 = O 4 = 0°,180°. This case is doubly de- 
generate with respect to translation. (See 
fig. 4(b).) The zeros of Dm were obtained 
numerically because of its complexity. 


The singularity condition for the wrist joints is 
independent of #5 and 6 $ and is given as follows: 

= 2(1 - 44 ) = 0 ( 9 ) 

The wrist singularity occurs only when 9q = ±90° 
and 67 = ±90° simultaneously. As shown in fig- 
ure 4(c), joints 5 and 7 provide yaw, joints 6 and 8 
provide roll, but the freedom to pitch has been lost. 
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The symbol EE in figure 4(c) represents the end 
effector. 

Table 1 summarizes the four singularity condi- 
tions for the general eight-axis arm. For the ARMII, 
as shown in table A2, the cases where #2 or 84 
equal 180° and 0j = +90° are out of joint motion 
ranges, and the case 8q = ±90° coincides with the 
joint limits. 


Table 1. Singularity Conditions 


Number 

Condition 

1 

0 4 = 0°, 180° 

2 

8 2 = 0°, 180°; 0 3 = ±90° 

3 

0 

oc 

0 

II 

II 

is 

4 

0 6 = ±90°; 0 7 = ±90° 


Entries 1 and 3 (3 is a subset of 1) are work space 
limit singularities, and entries 2 and 4 are work space 
interior singularities. These singularity conditions 
were derived from the partitioned solution. The sym- 
bolic analysis for IJ 5 X 7 J 5 X 7 I too complicated for 
analytical treatment. With the exception of the el- 
bow joint work space limit singularity, 84 = 0°, 180°. 
However, an intensive numerical computer search in- 
dicated that the full Jacobian matrix shares all four 
singularity conditions from table 1. The computer 
search also indicated that no additional singularities 
exist for the full solution. This result is expected 
because of the spherical wrist. Reference 16 shows 
that for a nonredundant manipulator with a spherical 
wrist, the partitioned arm and wrist singularities cor- 
respond one-to-one with the singularities of the full 
Jacobian matrix. This condition is not true for ma- 
nipulators with a nonspherical wrist. The computer 
search involved all possible combinations of joint an- 
gles in steps of 5° over a full 360° rotation. At each 
step, [ J Tj x 7 J 5 x 7 1 was computed and the cases near 
zero were printed. 

In the neighborhood of manipulator singularities, 
both full and partitioned symbolic solutions be- 
come ill-conditioned. A numerical singular value de- 
composition solution can be used, where the trajec- 
tory cannot be satisfied, but the alternate solution is 
the best available given the singular condition. 

3.3. Objective Functions 

This section presents three objective functions for 
use in the homogeneous solutions to optimize the 
performance of a redundant manipulator. Two ob- 
jective functions have been implemented for the full 


and partitioned solutions: joint limit avoidance and 
manipulability maximization (singularity avoidance). 
A third objective function for obstacle avoidance is 
discussed but has not been used. 

The following function was proposed by Liegeois 
(ref. 2) to allow the manipulator to avoid joint limits: 



where 0 t is the current value for joint 7 , 8 c i is the 
center of travel for joint i, and A#, is half the range 
of travel for joint i. The function is normalized by 
its denominator so that each joint has equal weight 
regardless of its range of travel. This function is 
minimized for joint limit avoidance. Equation (10) 
is defined for the full solution. For the partitioned 
solution, H& is defined for i = 1 to 4, and H\y for 
i = 5 to 8. Klein and Huang (ref. 5) state that equa- 
tion (10) leads to a suhoptimal joint limit avoidance 
solution. The optimal norm to use is the maximum 
norm; they use the p-norin to approach the maxi- 
mum norm with a tractable gradient. Equation (10) 
is used in this paper. 

From reference 17 Yoshikawa’s definition of 
manipulability is as follows: 

H M (B) = yj jjTj (11) 


This function is maximized to ensure that the 
manipulator operates far from singular configura- 
tions. The value of equation (11) is zero when 
the manipulator is in a singular configuration. For 
the full homogeneous solution, the function is 

Hm — J | J. 5 x 7 J ^ X 7 and for the partitioned solution 


the functions are H a = yj |J w j <\\ ftnd H\V = 

\j i ^ lr^i ft\- The gradients of the two implemented 
objective functions have been derived symbolically. 


Yoshikawa (ref. 17) proposes minimization of the 
following function for obstacle avoidance: 


H„(9) = l -(6 - 0 r ) T W(6-0 r ) (12) 

where 0 r is a single constant manipulator configu- 
ration that is good for avoiding collisions with an 
obstacle, and W is a diagonal matrix with posi- 
tive gains. Except for normalization, equation (12) 
is similar to equation (10). Equation (12) has not 
been implemented for the eight- axis arm because pre- 
determined information is required on the obstacles 
in the work space. I 11 unstructured environments 
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such as space, this method is too limiting because 
it is not adaptive to unknown obstacles. Other 
authors have proposed more robust and adaptive 
methods for obstacle avoidance with redundant ma- 
nipulators. For instance, Karlen et al. (ref. 18) dis- 
cuss an algorithm for reflexive obstacle avoidance 
using proximity sensors along the redundant manip- 
ulator. In reference 4, Nenchcv presents 21 references 
dealing in part with obstacle avoidance. 

4. Results 

The data reported in this section were obtained 
via graphical simulation. The ARMII manipulator 
was used for the examples in this section to verify 
the simulated results on actual hardware. 

4.1. Local Optimization Results 

This section presents local redundancy optimiza- 
tion results for the full solution. Results are given for 
joint limit avoidance, manipulability maximization, 
and a combination of the two. The units are me- 
ters per second and radians per second for Cartesian 
translational and rotational velocities, respectively, 
and degrees for joint angle. The joint limit con- 
straint function Hj is dimensionless, and the units 
for manipulability H\f are square meters. 



Figure 5. Initial configuration for joint limit avoidance. 

4-1 -1- Joint limit avoidance . The constraint 
function used is equation (10) with n = 8. The tra- 
jectory is an end-effector roll, X = {0,0, 0,0, 0,0.4} 7 
As shown in figure 5, 0 = {0, -30,0, -70,0,0, —50, 0} 7 is 
the starting configuration. Table A2 gives the joint 
limits for the ARMII. Joint 8 was designed to provide 
continuous bidirectional roll, but the limits were set 
to ±300°. The trajectory for this example is satisfied 



(a) Constraint, function. 




Time, sec 

(c) Cartesian error. 

Figure 6. Joint limit avoidance. 

by a combination of all joints. Figure 6(a) shows the 
constraint function value for the particular solution 
only (A; = 0 in eq. (4b)) arid the particular solution 
with joint limit avoidance (minimization, A: = —0.5). 
With no optimization (k = 0), the objective function 
is greater, which means the joints are generally far- 
ther from their center of travel and thus nearer to 
limits. Optimization (A: = —0.5) improves this situ- 
ation and forces the joints to be farther from their 
limits. 

A compelling demonstration of the benefit of joint 
limit avoidance optimization shows when a joint limit 
is encountered. For the same trajectory, figure 6(b) 
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shows #5 hitting a limit at 9.5 sec, but avoiding the 
limit when the function is minimized. The associated 
Cartesian error due to the joint limit is shown in 
figure 6(c). With joint limit avoidance, the resulting 
Cartesian trajectory is useful for a larger time span. 

4-1*2. Manipulability maximization (sin- 
gularity avoidance). The constraint function H\f 
is defined following equation (11). The commanded 
Cartesian trajectory is X — {0.01,0 01, 0.01, 0,0, 0} 7 , 
and the initial manipulator configuration 6 = 
{0, -10, 75. -70, 0 , -80, -90, 0} 7 (fig. 7) is near both arm 
and wrist singularities. Figure 8 shows Hjtf for the 
particular solution only (A: — 0) and with manipula- 
bility maximization [k — 1). Both curves start with 
manipulability near zero because the initial config- 
uration is nearly singular. As the curve for k = 0 
shows, the chosen trajectory tends to increase the 
manipulability gradually even when no maximiza- 
tion is applied. However, the optimized solution in- 
creases the manipulability rapidly and then main- 
tains it at a high level during the move. Both curves 
fall off rapidly as the trajectory drives the manip- 
ulator into the work space limit singularity where 
0.\ = 0°. Optimization does nothing to improve this 
situation because no homogeneous term exists for #4, 
as explained in section 3.2.2. 



Figure 7. Manipulability maximization for initial 
configuration. 




Time, sec 

Figure 9. Manipulability maximization for //.\/. 

Figure 9 dramatically demonstrates the bene- 
fits of manipulability maximization. For this fig- 
ure, the initial manipulator configuration is the same 
as the one in figure 7, but the Cartesian trajec- 
tory is X = {0, -0.01, 0.0,0, 0} 7 . Without optimization 
(A: = 0), the trajectory drives the manipulator into 
the neighborhood of the 9q — —90°, 9j = —90° in- 
ternal wrist singularity, and the manipulability mea- 
sure remains near zero for the entire time. With ma- 
nipulability maximization (k = 1), the manipulator 
avoids the singularity and achieves the commanded 
trajectory with high manipulability. 

4-1-3. Combined optimization . Experiments 
with manipulability maximization with the full solu- 
tion revealed that regions exist where the local maxi- 
mum for Hjif lies outside the joint limits of table A2. 
The algorithm attempts to increase H\j , but it is 
not physically realizable because of the physical joint 
limits. Such cases indicate that combining optimiza- 
tion criteria is sometimes necessary. For the example 
in this section, the Cartesian command and initial 
configuration are the same as those for the manipu- 
lability example in figure 9. The objective function is 
constructed to maximize manipulability while avoid- 
ing joint limits: 

H{6) = k M H M + kjHj (13) 
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where the manipulability and joint limit functions 
are defined in equations (11) and (10); k\f must be 
positive to maximize H\f . and kj must be negative 
to avoid joint limits. 

An example of a case where manipulability maxi- 
mization and joint limit avoidance must be combined 
is given in this section. The Cartesian trajectory 
is X = { 0 . 01 , 0 . 01 , 0 . 01 , 0 , 0 , 0 } 7 . The initial manipula- 
tor configuration is 0 = {(), - 10 , 85 . - 70 , 0 , - 80 , - 90 . 0 } 7 ; 
this configuration is the same as the one in figure 7, 
with one change: starts at 85°, which is 10° closer 

to the internal arm singularity. In this example, joint 
limits are reached for and during the trajectory 
with manipulability maximization only. 

Figure 10(a) compares H\j for manipulability 
maximization only (A:,^/ = 1, kj = 0) and for ma- 
nipulability maximization with joint limit avoid- 
ance (JLA) (k\j = 1 <kj = — 1). A third plot shows 
the manipulability for the trajectory without any 
optimization, A* = 0 (actually, k\j = 0. kj = 0) for 
comparison. Without any optimization (k = 0), the 
manipulability remains low for the entire trajectory. 
With manipulability maximization and without joint 
limit avoidance (MM in fig. 10(a)), the manipulabil- 
ity is highest, but this condition is not physically 
realizable because of the joint limits encountered. A 
joint limit for 6y is reached at 9 sec, which causes 
the Cartesian error to increase rapidly (fig. 10(b)) as 
the actual trajectory deviates from the commanded. 
Because of this error, figure 10(a) shows that with- 
out joint limit avoidance, the manipulator reaches 
the 0.\ = 0° work space limit singularity (where H\j 
goes to zero) sooner than it does with joint limit 
avoidance. With both manipulability maximization 
and joint limit avoidance (MM + JLA in fig. 10(a)), 
the manipulability assumes intermediate values that 
are realizable because no joint limits are encoun- 
tered. Joint limits were not encountered for the no 
optimization (A* = 0) case, and the plot is so simi- 
lar to MM -f JLA in figure 10(b) that it is not in- 
cluded. The instability reflected around 28 sec in 
figures 10(a) and 10(b) for the MM case is due to the 
work space limitation singularity; these data were ob- 
tained through the use of simulation not the actual 
ARMII hardware. 

4.2. Comparison of Partitioned and Full 

Solutions 

The results presented previously arc’ for the full 
solution. The partitioned solution is suboptimal 
because the particular and homogeneous solutions 
are optimized separately for the translational and 
rotational parts. However, as shown in the results 
of this section, the difference is not significant. 


MM 




Figure 10. Combined optimization. 



Figure 1 1 . Full vs partitioned joint rate magnitude. 

4-2,1. Comparison of particular solutions. 
The full particular solution (eq. 4(a)) yields the 
least-squares solution for joint rates. The parti- 
tioned particular solutions (eqs. 6(a) and 7(a)) re- 
sult in a higher Euclidean norm joint rate magnitude. 
Figure 11 shows a typical result. This simulation 
moves the manipulator toward the singularity where 
8\ — 0°. The maximum percent difference between 
the full and partitioned joint rate magnitudes is 2.5, 
which decreases as the manipulator approaches the 
singularity. 
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4*2,2. Joint limit avoidance. The Cartesian 
trajectory and initial manipulator configuration 
in this example are X - {0,0,0, 0,0, 0.4} r and 
0 = {0, -30,0, -70,0,0, -50, Op , the same as the exam- 
ple of section 4.1.1. Figure 12 shows joint limit 
avoidance for the full ( k = —0.5, repeated from 
fig. 6 (a)) and the partitioned (k^ = k\\r = — 0 . 5 ) so- 
lutions. The results are nearly identical. The full 
objective function is only slightly less than the par- 
titioned objective function. Theoretically, the full 
solution avoids joint limits better than the parti- 
tioned because the objective function is minimized to 
smaller values, but practically there is no difference. 



Figure 12. Full vs partitioned joint limit avoidance. 


4*2.3. Manipulability maximization. The 
Cartesian trajectory and initial manipulator configu- 
ration in this section are X = {0.01,0.01,0.01, 0,0, 0} 7 
and 0 = {0,-10,75, -70,0, -80,-90, 0} r , the same as 
the first example of section 4.1.2. Figure 13 com- 
pares manipulabilities for the full (fc = 1 , repeated 
from fig. 8 with a different vertical scale) and the 
partitioned {k^ = k\y = 1 ) solutions. The constraint 
functions for the partitioned case are the arm and 
wrist manipulabilities, #4 and H\y , defined follow- 
ing equation (11). The units for H& are m 2 and H\y 
is dimensionless. 


Full 

Arm 



Figure 13. Full vs partitioned manipulability maximization. 


Figure 13 shows that the wrist manipulabil- 
ity for the partitioned case increases rapidly to 
y/2 and is held there for the remaining trajectory. 
The partitioned arm manipulability increases to a 
lower value and falls off as the elbow work space 
limit singularity is approached. The full manipula- 
bility increases to a value in between the arm and 
wrist curves. It also falls off as the elbow work space 
limit singularity is approached. Therefore, the wrist 
manipulability appears to be superior to the full so- 
lution, and the arm manipulability tends to be lower 
than the full solution. 

4*2.4* Accuracy of partitioned solution. In 

the eight-axis singularity analysis of section 3.2.4, 
the singularities of the partitioned solution were con- 
cluded to be identical to those of the full solu- 
tion; these are the physical manipulator singulari- 
ties. Therefore, the partitioned solution does not 
add algorithmic singularities to those found in the 
full case. 

When a determinant is zero, the solution is sin- 
gular; when it is near zero, the solution is ill- 
conditioned. The following question arises: Is 

the partitioned solution ill-conditioned in a larger 
neighborhood around the singularities than the full 
solution? To answer this question, joint trajectories 
were designed to drive the graphical simulation of the 
manipulator through two work space interior singu- 
larities (#2 = 0°, #3 = 90° and 9$ — 90°, #7 = -90°) 
simultaneously, and the full and partitioned |JJ 7 | 
were studied. Figure 14 shows the manipulator in 
these singular conditions, where the full configura- 
tion is 6 = { 0 , 0 , 90, -70, 0 , 90, -90, 0 } T . This configura- 
tion is a combination of those shown in figures 4 (a) 
and 4(c). 

Figure 15 presents the results of this study. Start- 
ing from 0 = {0, -10,80, -70,0,80, -100, 0} 7 \ joints 2, 
3, 6 , and 7 were updated by l°/scc, so both sin- 
gularities were reached at 10 sec. Figure 15 is a 
plot of |J 5 X 7 J 7 x ^| (5 x 7), \J \u ja^\u Ia\ ( arm ) an d 
(wrist). The arm curve is symmetric; the 
5x7 and wrist curves are not because joint 6 hits 
a limit at the wrist singularity and does not move 
through. 

Figure 15 provides a clear answer to the question 
of ill-conditioning: The full solution (5 x 7) is ill- 
conditioned in a much greater neighborhood around 
the singularities than the partitioned solutions (arm 
and wrist). Therefore, the robustness of the parti- 
tioned solution is an advantage when compared with 
the full solution. 
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Figure 14. Internal arm and wrist singular configurations. 



Figure 15. Full vs partitioned solutions near singularities. 

5. Eight- Axis Arm Design Limitation 

This section discusses a limitation in the eight- 
axis arm design regarding redundancy optimization. 
Design alternatives are presented in appendix D to 
alleviate the problem. 

As discussed in section 3 . 2 . 1 , the length of reach 
from shoulder to wrist for manipulators with a spher- 


ical wrist, spherical shoulder, and a single elbow joint 
is a function of only the elbow joint angle. Figure 3 
shows this relationship. Regardless of the # 3 , #5 val- 
ues, the length SW (fixed by the Cartesian trajec- 
tory) is a function of only $ 4 . This function is ob- 
tained from the cosine law discussed in reference 15. 
A derivative of this relationship yields the unique 
solution for 0 4 in equation (3). 

The limitation in this design is that the elbow 
joint can only be used to satisfy the primary task, the 
Cartesian trajectory. As discussed in section 3.2.2, 
the elbow joint cannot be used in the secondary task 
of manipulator performance optimization because it 
does not influence the self-motion of the eight-axis 
arm. As a trade-off, a benefit of this design is sim- 
plified kinematics, and greatly reduced computation 
requirement when exploiting the independent elbow 
rate solution and the wrist-partitioned solution. 

Although the eight-axis arm has two redundant 
degrees of freedom, it has only one mode of self- 
motion, the elbow orbit about the line SW. (See 
fig. 2.) This self-motion is also achieved by seven- 
degree-of- freedom manipulators with only one redun- 
dant freedom. The question becomes, Is the ex- 
tra overhead and reduced reliability with the extra 
joint justified considering only one self-motion mode 
is achieved and the elbow joint cannot be used for 
optimization? 

Appendix D discusses kinematic design modifica- 
tions to address the existing eight-axis arm limita- 
tions. The emphasis is to provide a second mode of 
self-motion, in the plane SEW, and to ensure that 
the elbow joint participates in optimization. 

6. Conclusions 

This paper presents local redundancy optimiza- 
tion applied to a class of eight-axis redundant arms. 
The theory has been implemented on a member 
of the class, the Advanced Research Manipula- 
tor II (ARMII). The performance constraints for the 
secondary task optimization are joint limit avoid- 
ance, manipulability maximization (hence singular- 
ity avoidance), and a combination of the two. Re- 
sults are presented to show the effectiveness of the 
redundancy optimization. 

The methods used in this paper are well-known 
from the redundant manipulator literature. The 
contributions of this paper are fourfold. 

1 . Real-time local redundancy optimization for 
an experimental eight-axis manipulator is 
demonstrated. Most experimental efforts in 
the past have used seven- axis arms. 
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2. A kinematic design limitation of this class 
of eight-axis arms is explained. The length 
of reach from the shoulder to the wrist is a 
function of only the elbow joint angle, which 
means that the elbow angle participates only 
in the primary task, and cannot affect the sec- 
ondary optimization task. Even though there 
are two redundant degrees of freedom, there 
is only one mode of self-motion. The ge- 
ometry is suited for low computation redun- 
dancy resolution, but the trade-off is reduced 
versatility. 

3. Symbolic pseudoinverses and objective func- 
tion gradients are used for both full and par- 
titioned solutions. In addition, for the parti- 
tioned solution, the symbolic arm and wrist 
null-space projection matrices are given. 

4. This paper shows that a partitioned solution 
can be applied to obtain similar optimization 


results as the full solution, without the in- 
troduction of algorithmic singularities. The 
motivation for the partitioned solution is re- 
duced computation. The partitioned solution 
is subopt imal becatise translational and ro- 
tational terms are optimized separately for 
both primary and secondary tasks, but pre- 
sented results show the difference is not sig- 
nificant. Singularity analysis reveals that no 
algorithmic singularities exist for the parti- 
tioned solution. The partitioned and full so- 
lutions share the same physical manipulator 
singular conditions. Also, the partitioned so- 
lution is shown to be ill-conditioned in smaller 
neighborhoods of the shared singularities than 
the full solution. 

NASA Langley Research Center 

Hampton, VA 23681-0001 

January 10, 1994 
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Appendix A 

Advanced Research Manipulator II 

This appendix describes the Advanced Research 
Manipulator II (ARMII), which is representative of 
the class of redundant eight-axis manipulators in 
figure 1. This appendix also gives the Denavit- 
Hartenberg parameters and the Jacobian matrix for 
this class of manipulators. 

Figure A1 is a photograph of the ARMII, and 
figure A2 is a kinematic drawing of the ARMII. 
The following features distinguish the ARMII from 
existing industrial manipulators: two redundant 

degrees of freedom; four-jointed spherical wrist; 
continuous bidirectional end-effector roll; no kine- 
matic offsets; a high payload- to-' weight ratio (1:5); 
high joint stiffness with 200:1 harmonic gearing 
at each joint; absolute position potentiometer, in- 
put and output relative encoders, temperature sen- 
sor, limit switches, and mechanical stops for each 
joint; high torque direct current brush servomotors 
with integral brakes and encoders; high link stiff- 
ness with graphite or epoxy composite material; and 
space- flight-qualifiable components. 


Table Al. Eight- Axis Arm Denavit-Hartenberg Parameters 
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Table A2. ARMII Joint Limits 
[Units are in degrees] 
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Figure Al. ARMII photograph. 



/////// //////7 

Side view Front view 

Figure A2. ARMII kinematic diagram. 

The eight-axis arm Dcnavit-Hartenbcrg parame- 
ters (Craig convention (ref. 14)) and ARMII joint 
limits plus equation (10) terms are given in tables Al 
and A2. In table Al, nominal values for the fixed 
lengths are d-\ = 695 mm and dg = 545 mm. 
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where 


The Jacobian matrix for the eight- axis arm ex- 
pressed in the elbow Cartesian coordinate frame, {4}, 
is presented in reference 13 as follows: 

JfJL 0 
Jll Jlr_ 
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A = d^C4 + d$ 

B = d$ + (/5C4 

^5 — C 2 S 4 4- S2C3C4 

Kq = “C2S4 + S2C3S4 
^16 = ^3 S 2 C 3 + <^5 A 5 
KK\ = S5S7 + C556C7 


KK3 = -C5S7 + S5.Sf,C7 

Cartesian velocities used with this Jacobian matrix 
must be expressed in frame {4}. If velocities are com- 
manded in a different frame (e.g., {8}), the following 
coordinate transformation is required (ref. 13): 



0 j 8 
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Appendix B 

Symbolic Partitioned Pseudoinverse 

The symbolic form for the pseudoinverse of the 
partitioned reduced Jacobian matrix is given in this 
appendix (ref. 15). Because 6\ is solved indepen- 
dently with equation (3), column 4 and row 1 are 
removed from J [j i . Thus, the following transla- 
tional pseudoinverse, used in equation (7a), is of 
order 3x2: 
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The 4x3 rotational pseudoinverse used in equa- 
tion (7b) is as follows: 
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Appendix C 


Symbolic Partitioned Null-Space 
Projection Matrices 

The symbolic null-space projection matrix for 
J 1 [/ £4 1 which is used in equation (6b) , is given as 
follows. This matrix is symmetric; Dm and K\\ are 
given in appendix B. 

fjll 3 12 3 13’ 

{h - ^WLA^WLa) = h “ 7. 322 32 3 

U VL 

J33 - 

where 


322 = ^{a/j + [2 4 - (4 + l)si]si} + Ni 

323 - ~d§K 1 1 S 2 S 3 S 4 

J33 = d|(i - ^•‘>•3) •‘>■4 
M\ = ^ 2(^2 T 2 C 2 C 354 C 4 ) 

N\ = d^2(d^S2 + 2d 5 A» 

The symbolic null-space projection matrix for Jlr, 
which is used in equation (7b), is given as follows. 
This matrix is symmetric; Drr is given in appen- 
dix B. The subtraction from the identity matrix is 
included in the following equation: 


Jn= 4 [Ml - (2.s| - l)4s2] + N { 

3 12 = d5*2«3C3»4 
jl3 = d~ y K\ 1 C3S4 
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Appendix D 

Kinematic Design Alternatives to the 
Existing Eight- Axis Manipulator 

Kinematic limitations regarding the existing eight- 
axis arm of figure 1 and their effect on performance 
optimization using redundancy are discussed in sec- 
tion 5. To provide two modes of self-motion with two 
redundant joints and to allow the elbow joint to in- 
fluence performance optimization, kinematic design 
modifications to the arm of figure 1 are considered 
in this appendix. Only one change is required: re- 
configure joint 5 so that it is parallel to joint 4, as 
shown in figure Dl. With this modification, the sub- 
assembly connecting the shoulder to the wrist no 
longer assembles in only two configurations in plane 
SEW (elbow up and down) but is a four-bar linkage 
with one degree of freedom in plane SE 1 E 2 W. This 
design has two modes of self-motion: the original el- 
bow orbit (fig. 2), and the new four-bar motion in 
the plane of the links connecting S and W. These two 
modes provide more flexibility for obstacle avoidance 
and null-space optimization than the original design. 
Since the relationship of equation (3) no longer holds, 
null-space terms are associated with joint 4. 



An analogous design alternative is to replace the 
revolute joint 5 with a prismatic joint acting along 
the line connecting joint 4 and W. (See fig. D2.) In 
this case, the subassembly connecting S to W is a 
one- degree-of- freedom slider-crank mechanism with 
a similar second mode of self-motion in plane SEW. 




A drawback of the proposed design alternatives 
of figures Dl and D2 is that the four-axis spherical 
wrist subassembly of the original arm is reduced to 
three joints. The partitioned solution applied to 
the new designs would not be useful because the 
wrist subassembly is no longer redundant, so no 
wrist performance optimization using self-motion is 
possible. Therefore, figure D3 proposes a nine-axis 
redesign where a second elbow revolute joint (parallel 
to joint 4) is added between joints 4 and 5 of figure 1. 
(Alternatively, the prismatic joint can be used.) For 
this concept, there are two self-motion modes, the 
elbow joint is not excluded from optimization, and 
a partitioned solution can be applied. However, a 
similar problem from the original eight-axis arm in 
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figure 1 exists: there are three redundant degrees of 
freedom but only two modes of self-motion. 

There are trade-offs among the original design of 
figure 1 and the proposed redesigns of figures Dl, D2, 
and D3. The original design has simpler kinematics, 
joint 4 variables solved independently, and allows 
an efficient partitioned solution. However, joint 4 
has no null space and only one mode of self-motion. 


The eight-axis redesign concepts provide two modes 
of self-motion, a null-space term associated with 0 \, 
but no four-axis spherical wrist to allow a general 
partitioned solution with reduced computation. The 
nine-axis redesign provides all desired attributes, at 
the cost of an extra joint. For general tasks, the 
nine-axis alternative is recommended by the author, 
although more work must be done to validate this 
recommendation. 
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